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(54) ROBOT CONTROL DEVICE 

(57)Abstract: 

PURPOSE: To conform the robot control device to a change 
to any given axial construction by making combination of 
coordinate transformation matrices on the basis of the data 
collected by an axis construction discrimination means to 
calculate each joint angular velocity, etc., of the manipulator 
for each point of passage. 

CONSTITUTION: A manipulator 1 is constructed of 
connections mad of given arm joint modules 2a, 2b,... 2h. Each 
arm joint module is equipped with a motor for driving its axial 
shaft and with a controller 3a, 3b,... or 3h for controlling 
operation. The robot control device has coordinate 
transformation matrices for various axis-type arm joint 
modules and makes combination of these matrices on the 
basis of the constructional data of the manipulator 1 
discriminated by an axis construction discrimination means 7 
to calculate an amount of change in each joint angle which is 
necessary for a terminal effector 2h of the manipulator 1 to 
move up to a next passage point, i.e., a position up to which 
it is to move by the next sampling time, in regard to each 

passage point determined by a trajectory calculation function 8 thus to send it to each controller. 
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